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(54) MECHANICAL VIBRATION DETECTOR AND VIBRATION DAiWiPING CONTROLLER 



(57) Provided is a mechanical-vibration detecting 
apparatus in which not only adjustment is easy but also 
mechanical vibration can be taken out with high accu- 
racy, and a vibration-reduction control apparatus by 
which reduction of mechanical vibration can be 
achieved. 

In a motor control apparatus for controlling the 
torque of a motor, provided are an equivalent rigid body 
model 103: a proportional operation means 104; a high- 
pass filter 105; and means for adding a torque signal 



and an output of the proportional operation means to 
supply a resulting addition signal to the equivalent rigid 
body model, and for subtracting an output of the equiv- 
alent rigid tsody model from a velocity signal of the 
motor control apparatus to supply a resulting difference 
signal to the proportional operation means and to the 
high-pass filter so that an output of the high-pass filter is 
used as a mechanical vibration corrtrol signal. 
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Description ^ 

[Technical Field] 

s The present invention relates to a motor control apparatus having a mechanical-vibration detecting apparatus for 
detecting the vibration of a mechanism driven by a motor. 

[Background Art] 

10 As a mechanical-vibration detecting apparatus and a vibration- reduction control apparatus in a motor control sys- 
tem, there Is an apparatus proposed in Japanese Patent Application No. 127859/94 filed by this applicant. In this prior 
art, a motor-containing mechanism system Is separated into an equivalent rigid body system and a mechanical vibra- 
tion system so that mechanical vibration Is estimated at a high speed by an observer based on an equivalent rigid body 
system model to perform vibration reduction control. 

15 In the prior art, however, a quadratic observer is constituted with the angular velocity and step-like torque distur- 
iDance of the equivalent rigid body system as state variables, so that not only an equivalent rigid body model and a pro- 
portional operation means but also an integrating operation means are required in order to constitute a mechanical- 
vibration delecting apparatus. Two parameters are required to be set for the observer and. furthermore, the phase of a 
mechanical vibration signal varies largely in accordance with the set values of the parameters so that there arises a 

20 problem that it is difficult to adjust the parameters. 

[Disclosure of the Invention] 

Therefore, an object of the present invention is to provide a mechanical-vibration detecting apparatus in which not 
25 only adjustment is easy but also mechanical vibration can be taken out with high accuracy, and to provide a vibration- 
reduction control apparatus by which reduction of mechanical vibration can be achieved. 

In order to achieve the above problem, in a motor control apparatus for controlling the torque of a motor, the first 
invention of the present application is characterized by comprising: 

30 an equivalent rigid body model; 
a proportional operation means; 
a high-pass filter; and 

means for adding a torque signal of the motor control apparatus and an output of the proportional operation means 
to supply a resulting addition signal to the equivalent rigid body model, and for subtracting an output of the equiva- 
35 lent rigid body model from a velocity signal of the motor control apparatus to supply a resulting difference signal to 
the proportional operation means and to tiie high-pass filter so tiiat an output of the high-pass filter is used as a 
mechanical vibration control signal. 

In a motor control apparatus for controlling the torque of a motor, the second invention of the present application Is 
40 Characterized by comprising: 

an equivalent rigid body model; 
a proportional operation means; 
a high-pass filter; 
45 a phase adjuster; 

an amplitude adjuster; and 

means for adding a torque signal of the motor control apparatus and an output of the proportional operation means 
to supply a resulting addition signal to the equivalent rigid body model, and for subtracting an output of tiie equiva- 
lent rigid body model from a velocity signal of the motor control apparatus to supply a resulting difference signal to 
so the proportional operation means and to the high-pass filter, wherein an output of the high-pass filter is supplied to 
the phase adjuster and an output of the phase adjuster is supplied to the amplitude adjuster so that a signal 
obtained by adding an output of the amplitude adjuster to a torque command given to the motor control apparatus 
is used as a new torque command. 

55 In a motor control apparatus for controlling the torque of a motor, the third invention of the present application is 
characterized by comprising: 

an equivalent rigid body model; 
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a proportional operation means: 

a high-pass filter; 

a phase adjuster: 

an amplitude adjuster; and 

5 means for adding a torque signal of the motor control apparatus and an output of the proportional operation means 

to supply a resulting addition signal to the equivalent rigid body model and for subtracting an output of the equiva- 
lent rigid body model from a velocity signal of the motor control.apparatus to supply a resulting difference signal to 
the proportional operation means and to the high-pass filter, wherein an output of the high-pass filter is supplied to 
the phase adjuster and an output of the phase adjuster is supplied to the amplitude adjuster so that a signal 

10 obtained by adding an output of the amplitude adjuster to a velocity command given to the motor control apparatus 
is used as a new velocity command 

By the aforementioned means, a linear equivalent rigid body observer is constituted so that one integrating means 
becomes unnecessary and the range of the parameter for stabilizing the system is widened correspondingly. Further- 
15 more, because only one parameter is required for setting the observer and the sensitivity of the parameter is low with 
respect to the phase of the mechanical vibration signal, it is easy to adjust the parameter. 

As described above, according to the present invention, it is possible to constitute an equivalent rigid body observer 
in which the number of parameters to be set Is small and the range of the parameter to be set is wide. Accordingly, there 
arises an effect that it is possible to provide a mechanical-vibration detecting apparatus in which not only adjustment is 
20 easy but also mechanical vibration can be taken out with high accuracy, and to provide a vibration-reduction control 
apparatus by which reduction of mechanical vibration can be achieved. 

[Brief Description of the Drawings] 

25 Fig. 1 iis a diagram showing a first embodiment of the present invention. Fig. 2 is a diagram for explaining an exam- 
ple of a resonance mechanism. Fig. 3 is a diagram showving a second embodiment of the present invention. Fig. 4 is a 
diagram showing a fourth embodiment of the present invention. 
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[Best Mode for Carrying Out the Invention] 



Specific embodiments of the present invention will be described below. 

A first embodiment of the present invention as to a mechanical-vibration detecting apparatus illustrated in Rg. 1 will 
be described. In the drawing, a block 102 shows a mechanical- vibration detecting apparatus constituted by an equiva-. 
lent rigid body model 103. a proportional operation means 104, and a high-pass filter 105. The apparatus is supplied 
35 with a motor tbrqiie signal t and a rnotor velocity signal, (a motor angular velocity v^ is used here) and outputs a 
mechanical vibration signal. A block 101 shows a mechanism (including a motor) having a mechanical resonance sys- 
tem. 

The theory of detection of a mechanical vibration signal will be described below. Using an approximate method pro- 
posed in Japanese Patent Application No. 127859/94, a transmission function of the mechanism system 101 can be 
40 separated into an equivalent rigid body system (s) and a mechanical resonance system G2(s) as follows: 

Gn(s)=5^ (1) 



«2 2 
2 S +g-S+(Da 

G2(^>=^ (2) 



in which y is the reciprocal of a moment of inertia of the equivalent rigid body system, Do/y is the viscous friction coeffi- 
cient of the equivalent rigid body system, and and caa are the resonance frequency and antiresohance frequency of 
the mechanical resonance system. 
55 First, the theory of the present invention will be described. In Rg. 1, the block 101 sun-ounded by a broken line 
shows an mechanism (including electric motor) with a mechanical resonance phenomenon, and the block 102 sur- 
rounded by a one-dotted chain line shows a mechanical-vibration detecting apparatus according to the present inven- 
tion. As an example of the mechanism, assume a 2-inertia torsional resonance system shown in Fig. 2. Equations of 
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motion in the mechanical system in the drawing are given as follows: 



y^e ^+/<(e ^-e ,)+(d^+d ^-d ^ ,=a , (3a) 

5 ^L^L+^(^m-^L)+(D^ + D7.)e^-D7e^=0 (3b) 

in which 





: angle of the motor axis [rad] 


10 0L 


: angle of the toad axis [rad] 


56 


: torsional angle of the equivalent linear spring [racQ 


Jm 


: moment of inertia on the motor axis side [Kgm^] 


Jl 


: moment of inertia on the load axis side [Kgm^] 


K 


: spring constant of the equivalent linear spring [Nm/rad] 




: viscous friction coefficient of the motor axis [Nm/(rad/s)] 


Dl 


: viscous friction coefficient of the load axis [Nm/(rad/s)] 


Dt 


: equivalent viscous friction coefficient of the equivalent linear spring system [Nm/(rad/s)] 


U1 


: torque generated on the motor axis [Nm] 



20^ Assuming now that a state variable and an observation output (angular velocity of the motor) are given by the following 
equations (4a) and (4b) respectively, 



25 



^(0 = 



-x,(f)- 




■6^(0- 


^2(0 




ei(0 


^3(0 






/4(0 







(4a) 



30 

and 

y(0=e ^{thx^UMO 0 1 0]x(0 (4b) 
35 then state equations (5a) and (5b) are given according to the equations (1a) and (1b) as follows: 

x{t)=Ax{t)+bu{t) {5a) 
y(0=cx(0 (5b) 

40 

in which 
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so 
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c=(0 0 1 0| 



(6) 



The transfer function from the torque generated in the electric motor to the angular velocity (observation output) of 
the electric motor is given as follows: 



G{shC{sl-A)''^b 



3S 



40 



in which the characteristic equation P(s) is given as follows: 



^£ ^ m"^ L 



(7) 



(8) 



45 It was very difficult to factorize the equation (8) Into a product of a first-order expression and a second-order expression 
because parameters for the electric motor were combined with parameters for the mechanical resonance system. 
Accordingly, the physical meaning of the equation was not clear, so that a state observer could not but be formed with 
respect to the whole of the control system. 

Therefore, in the present invention, factors in the equation (8) are replaced as follows: 

so 



65 



0- {Ua.)J^ D„Dr>-D^DT*D^D, 



(9a) 



(9b) 
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5 in which a is the ratio of moment of inertia of the load to that of the motor as follows: 

a^JJJ^ (10) 
Using the equations (9a) to (9c), the equation (8) is expressed as follows: 

10 

P(S)-S^(c»/0,)+Do)S*+®rS+<»rDo (H) 

Assume newly the following equation: 

P(sMs*Do)(s^+-^s+a>^,) (12a) 



^ =sV(J-'+Do)sV(1+e)®fs+0)^Do (12b) 



in which e=s(1/Q ^)(D q/® . 

From the equations (1 1) and (12b). the equality 

25 

P(s)=P(s) 

holds when e=0. Accordingly. 

30 P(s) 

is an equation of approximating P(s), and e expresses an approximation error. It is apparent from the equation (13) that 
the approximation error e decreases as increases. For example. e<0.01 holds in the case of Qr>10 and ov>10Do. 
Assuming the equations (9a) to (9c). then the characteristic equation P(s) can be approximated by 

35 

P{s) 

In the equation (1 2b) as follows: 
A"(S)-s +{—+—+—+— )s +(—+---+- -.+- — )5+ _ =(s+D(j)(s +7^s+ca J (14) 

The equation (7) is rearranged by the following equations: 



45 

2 K K 



50 



(15b) 



Using the equations (14). (15a) and (15b) in the equation (7). the approximate equation of the transfer function can be 
deduced as follows: 

55 
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2 ®a 2 

^<^)=J-=5t!5 (1^) 



2 ^ a 2 

2 2 S +7r-S+a>, 



When the equations (16a) and (16b) are used, the 2-inertia resonance system can be separated into the equivalent 
rigid body system G^{s) shown in the block 101 surrounded by the broken line in Fig. 1 and the mechanical resonance 
15 system G2(s) as follows: 

2 

Gi(s)=jL ^ ^ (17a) 

20 

2 

~2 



^2 S +0-5+0), 

^ ' ^ (17b) 

25 



If the velocity of the equivalent rigid body system can be detected, the mechanical vibration component can be detected 
selectively on the basis of a difference signal which expresses a value obtained by subtracting the detected velocity of 
30 the equivalent rigid body system from the observation output. 

Therefore, a state observer is constituted with the equivalent rigid body system as a model. If the torque x of the 
motor Is used as a control input u under the condition that only the angular velodty v is considered with respect to a 
state X, according to the differential equation 

3^ i<0=-OoV(f)+YT(0 (18) 

the state equation of the equivalent rigid body system and the output equation are given as follows: 

x(0=ax(f)+£?iy(0 (19a) 

40 

y(0=cx {19b) 

in which 

x(t)=v(t). u{t)=T(t). a=-Do, b=Y. c=1. (19c) 
From the aforementioned equations, tiie observer can be formed as represented by the following equation: 



so 



x{t)^{a-kc)it{t) ^ky{t) ♦bu(t) (20) 



55 ^ From the equations (1 9) and (20). the estimated angular velocity value 
V is given by tiie following equation: 
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^(t) =-D^J<^( t) +lc(y(t) t) > +YT{t) (21) 



Assuming that the output y is given as the motor angular velocity v^ instead of y, then the equation (21) can be 
expressed by the block diagram in the block 102 of Fig. 1 . 

The mechanical vibration signal to be measured is obtained on the basis of the following signal £ of difference 
between the angular velocity of the motor and the estimated angular velocity value of the equivalent rigid body system: 

e{t)=v^{t)Mt) (22) 

However, because the observer represented by the equation (20) does not consider torque disturbance ^ an estimation 
error remains In the difference signal & if there is step-like torque disturt>ance i. Therefore, the difference signal £ is 
passed through the high-pass filter 105 so that a signal obtained by removal of the estimated error due to the torque 
disturbance is used as a mechanical vibration signal. From the above description, a mechanical vibration signal is 
obtained by the configuration in the mechanism vibration detecting apparatus 102. 

A second embodiment of the present invention as to the vibration-reduction control apparatus will be described 
below with reference to Fig. 3. Fig. 3 shows the case where the present invention is applied to a motor torque control 
apparatus. In Rg. 3. the motor-containing mechanism system 101 and the mechanical- vibration detecting apparatus 
1 02 are the same as those in the first embodiment. The reference numeral 1 06 designates a motor drive device which 
is supplied with a torque command and which outputs torque generated by the motor. The motor drive device 106 is 
constituted by a power amplifier, and so on. As a motor torque signal x to be supplied to the mechanical-vibration 
detecting apparatus 1 02, a generated torque monitor signal or a torque command signal is used. The mechanical vibra- 
tion signal estimated by the mechanical-vibration detecting apparatus 102 is supplied to the phase adjuster 107. The 
output of the phase adjuster 107 is supplied to the amplitude adjuster 108. so that a signal obtained by addition of the 
output w of the amplitude adjuster 108 to the torque command is supplied, as a new torque command, to the motor 
torque control apparatus. 

The phase adjuster 1 07 and the amplitude adjuster 1 08 adjust the phase and amplitude of the mechanical vibration 
signal which is an output of the mechanical-vibration detecting apparatus 102 so as to suppress the vibration of the con- 
trol system containing the motor and the mechanical resonance system. Because the mechanical vibration signal out- 
put from the rnechanical-vibration detecting apparatus 102 is advanced in phasje than the vibration of rnotor angular 
velocity v^ and the degree of the phase advance is adjusted on the basis of the gain h of the proportional operation 
means 104, the phase adjuster 107 may be constituted by a phase delay element such as a low-pass fijter, or the like. 
The amplitude adjuster 108 may be constituted by an amplifier or an arithmetic unit for multiplying the output signal of 
the phase adji^ter 107 by the gain. 

A third embodiment of the present invention as to the vibration-reduction control apparatus will be described below 
with reference to Fig. 4. Fig. 4 shows the case where the present invention is applied to a motor velocity control appa- 
ratus. In Rg. 4, the motor-containing mechanism system 101 and the mechanical vibration detecting apparatus 102 are 
the same as those in the first embodiment, and the motor drive device 106, the phase adjuster 107 and the amplitude 
adjuster 108 have the same functions as those in the second embodiment, except that the output w of the amplitude 
adjuster 108 is added to a velocity command so that the added-up signal is supplied, as a new velocity command, to 
the motor velocity control apparatus. The reference numeral 109 designates a velocity control compensator which is 
supplied with a difference signal between the velocity command and a velocity feedback signal, and which outputs a 
torque instruction. 

As described above, in the first, second and third embodiments, a value obtained by addition of torque disturbance 
d to the torque instruction may be supplied, as a new torque signal, to the mechanical-vibration detecting apparatus 102 
if the detected or estimated value of the torque disturbance d is obtained. In this case, the high-pass filter 1 05 becomes 
unnecessary. When, for example, the torque instruction is determined on the basis of proportional integrating control in 
the velocity control conrpensator 109 in the third embodiment, a value obtained by inversion of the positive/negative 
sign of the resulting value of the integrating operation may be used as the estimated torque disturbance value. 

[Industrial Applicability] 

The present invention can be applied to various motor-driven industrial machines such as machine tools, robots, 
semiconductor producing apparatuses, metallurgical apparatuses, and other general industrial machines, and office 
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machines. 
Claims 

5 1 , In a motor control apparatus for controlling the torque of a motor, a mechanical-vibration detecting apparatus char- 
acterized in that said apparatus comprises: 

an equivalent rigid body model; 
a proportional operation means; 

10 a high-pass filter; and 

means for adding a torque signal of said motor control apparatus and an output of said proportional operation 
means to supply a resulting addition signal to said equivalent rigid body model, and for subtracting an output 
of said equivalent rigid body model from a velocity signal of said motor control apparatus to supply a resulting 
difference signal to said proportional operation means and to said high-pass filter so that an output of said 

IS high-pass fitter is used as a mechanical vibration control signal. 

2- In a motor control apparatus for controlling the torque of a motor, a vibration-reduction control apparatus character- 
ized in that said apparatus comprises: 

20 an equivalent rigid body model; 

a proportional operation means; 
a high-pass filter; 
a phase adjuster; 
an amplitude adjuster; and 

means for adding a torque signal of said motor control apparatus and an output of said proportional operation 
means to supply a resulting addition signal to said equivalent rigid body model, and for subtracting an.output 
of said equivalent rigid body model from a velocity signal of said motor control apparatus to supply a resulting 
difference signal to said proportional operation means and to said high-pass filter, wherein an output of said 
high-pass filter is supplied to said phase adjuster and an output of said phase adjuster is supplied to said 
amplitude adjuster so that a signal obtained by adding an output of said amplitude adjuster to a torque com- 
mand given to said motor control apparatus is used as a new torque command. 

In a motor control apparatus for controlling the torque of a motor, a vibration-reduction control apparatus character- 
ized in that said apparatus comprises: j. 

an equivalent rigid body model; 
a proportional operation means; 
a high-pass filter; 
a phase adjuster; 
an amplitude adjuster; and 

means for adding a torque signal of said motor control apparatus and an output of said proportional operation 
means to supply a resulting addition signal to said equivalent rigid body model and for subtracting an output of 
said equivalent rigid body model from a velocity signal of said motor control apparatus to supply a resulting dif- 
ference signal to said proportional operation means and to said high-pass filter, wherein an output of said high- 
pass filter is supplied to said phase adjuster and an output of said phase adjuster is supplied to said amplitude 
adjuster so that a signal obtained by adding an output of said amplitude adjuster to a velocity command given 
to said motor control apparatus is used as a new velocity command. 

A mechanical-vibration detecting apparatus and a vibration- reduction control apparatus according to any one of 
Claims 1 through 3, characterized in that said apparatus further comprises means for obtaining a torque distur- 
k)ance signal by detection or estimation, and means for adding said torque disturbance signal to said torque signal 
to thereby use a resulting signal as a new torque signal. 

A mechanical-vibration detecting apparatus and a vibration- reduction control apparatus according to Claim 4, 
characterized in that said apparatus further connprises means for determining a torque command on the basis of 
an arithmetic operation including an integrating operation such as proportional integrating control, and so on, and 
means for inverting the positive/negative sign of the value of the integrating operation to use a resulting signal as 
said torque disturbance signal. 
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FIG. 2 
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